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1 Introduction 


Manipulating objects in space presents very different kinds of problems than it does 
on earth, in fact in many respects it is much more difficult. Accordingly, the design and 
control of space manipulators must reflect these differences. Reaction forces and torques 
normally damped by the earth, can create problems in space. For instance, an astronaut 
attempting to turn a valve on a relatively large space vehicle must be securely attached to 
the vehicle, otherwise, instead of turning the valve, the torque created will serve to turn 
the astronaut relative to the vehicle. This is by no means the only difficulty. Consider 
the following scenario: A master slave arm is being used to link beams for a large space 
structure. The sockets used to link the beams are transported on trays to the locations 
of the beam joints. Due to the zero gravity environment, the sockets must be fixed in 
place by some type of fastener to ensure they remain on the tray. Designing the end 
effector to release the fastener while maintaining a firm grasp on the socket will solve 
both the problems associated with torques and reaction forces, as well as the problem of 
minor perturbations dispersing the sockets in random directions. 

To accommodate these problems NASA developed the gripper /nut runner. The grip~ 
per/nut runner has two fingers which together have one degree of freedom. Similar to 
a vice, the width of the opening is the only variable. Centered between the fingers is 
a device for unscrewing nuts. Having one degree of freedom, this nut runner will be 
actuated by wrist rotations. Pictures of the gripper , side, end, and top views, can be 
found in figures 1, 2, and 3 respectively. Still in the design phase, the nut runner is not 
present in the figures. 


This project’s aim is to develop control laws (in some optimal sense) for the grip- 
per/nut runner end effector. Control laws for the gripper and nut runner portions of the 
end effector may be developed independently since these two systems are decoupled. A 
hybrid force/position controller will be used for both the gripper and nut runner. De- 
veloped here is the gripper controller only. Sensory data available to the controller is 
obtained from an array of strain qauges [1] as well as a linear potentiometer. Applying 
well known optimal control theoretic principles, the control which minimizes the tran- 
sition time between positions is obtained. In addition, a robust force control scheme is 
developed to contend with the strain gauge drift caused by extreme temperature varia- 
tions encountered in space. 

2 Mathematical Model 


For analytical purposes it is necessary to establish a mathematical model for the sys- 
tem. This model will include the actuator, transmission mechanism, and finger assembly. 

The finger actuator is a permanent-magnet DC motor. Models for these motors can 
be obtained from various sources. Used here is the model developed in Modern Control 
Engineering [2]. 
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Figure 1: Gripper (side view) 

The armature is modeled by a resistance R a , and inductance L a , both in series with 
a voltage source e b representing the back emf generated by the rotor rotations. Applied 
to flhe armature terminals is the control voltage e„. 

Proportional to the armature current by a constant k{, the motor torque is given by 

T m (t) = k,i a {t). (2.1) 

Also, the back emf is proportional to the rotor angular velocity by constant kb, 

e b (t) = k b w m (t). (2.2) 

The power in the motor armature can be expressed as 

P= € ^M1 ( N/s) (2<3) 

or 

p = {N/s) (2 .4) 
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Figure 2: Gripper (end view) 


yielding the relation 

% 


h ( 


rad — s 




(2.5) 


In all DC permanent magnet motors there exists a ripple torque caused by the nonuni- 
formity of the magnetic field. Thus the torque constant fc, is a function of the angular 
position of the rotor, and therefore periodic with period 2 tt. This periodic torque can 
effect the performance of the system, however, due to the high gear ratios being used, 
the effect is negligible. 

Applying D’Alembert’s law at the motor output, and Kirchhoff’s voltage law to the 
circuit model of the motor, the equations for the motor are as follows: 

= Tm(0 — 

L a ia{t) = e 0 (f) - R a ia(t ) - eb(t) 
where the coulomb friction, Tj, is included in the load torque, 

Selected for the actuation, the TRW 5A540-10 MM Planetary Gearmotor is manu- 
factured with gears inside the motor housing. The gearing has the effect of decreasing 


( 2 . 6 ) 

(2.7) 
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Figure 3: Gripper (top view) 

% 

the angular velocity and increasing the torque. The gear ratio is 27.94 and the minimum 
efficiency is 0.6. A summary of the other constants and their values for this motor can 
be found in Table 2.1. Motor variables are summarized in Table 2.2. 


constant 

definition 

value 

Ra 

armature resistance 

25.2 f l 

L a 

armature inductance 

7.2 mH 

ki 

torque constant 

0.0247 N - m/A 


back emf constant 

0.0247 V/rad/s 

J m 

rotor inertia 

3.67 x 10" 7 kg - m 2 

Bm 

viscous friction 

0.0 N - m/rad/s 

Tf 

coulomb friction 

0.0028 N - m 


Table 2.1 Motor Constants 
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Figure 4: Motor Model 



variable 

definition 

e a{t) 

*«(0 
€ b(t) 
w m (f) 
Tm(t) 
Tl( t) 

control voltage 
armature current 
back emf 
angular velocity 
motor torque 
load torque 


Table 2.2 Motor Variables 


A problem with the motor model developed above is that it gives the equations for 
torque and angular velocity without internal gears. These equations must be modified 
to account for gear effects. 

Ideal gears are initially assumed in the derivation. A gear is termed ideal if it has no 


5 





moment of inertia, no stored energy, no friction, and a perfect meshing of teeth. 

Let fc(') denote the contact force where the gears mesh and N = r\fr 2 the gear ratio. 
From equation (2.6), with Ti(t) = r 1 / c (t), the equation for the motor and attached gear 
is 

Jm&mit) — 2m(t) — f c {t) — B m Ul m (t) (2.8) 

also 

T 0 (t) = r 2 f c (t) (2.9) 

Combining these two equations, and using the geometrical equality w m (t) = Nu 0 (t), 
gives 

N 2 J m u> 0 (t) = NT m (t) - T 0 (t ) - N 2 B m u 0 (t). (2.10) 

Of course, in reality the gears are not ideal. To help account for this, an efficiency term, 
e, is included in the equation as follows 

N 2 J m u 0 (t) = eNT m (t) - T 0 (t ) - N 2 B m u 0 (t) (2.11) 


constant 

definition 

value 

ki = eNk{ 
h = Nk b 
Jm = N 2 J m 
Bm = N 2 B m 

torque constant 
back emf constant 
rotor inertia 
viscous friction 

0.4141 N - m/A 
0.6901 V/rad/s 
2.9 x 10 -4 kg — m 2 


Table 2.3 Equivalent Motor Constants 


By using 

the equivalent constants defined in Table 2.3 the adapted motor equations 

become 

— T m (f) Tl{ 1) B m L) 0 (t) 

(2.12) 

• 

Ej a (t) = e a (t) - Raia(t) - e b (t) 

(2.13) 


T m (t) — kfi a {t ) 

(2.14) 


e b (t) = k b u 0 (t) 

(2.15) 


The transmission mechanism used is an acme screw. The acme screw serves to trans- 
form rotary motion of the motor to linear motion needed to move the fingers. A screw 
with a small lead angle, l = 1.6 mm, was used so that larger finger tip forces could be 
developed while using a smaller motor. As a trade-off, the maximum velocity attained 
during opening and closing is lower. Another benefit of having a small lead angle is that 
the screw is self locking under reasonable load conditions. This is an important feature 
since it will allow the end effector to hold objects without using power. This property 
helps to eliminate problems created because of poor heat dissipation in space. 

Used to link the motion of the fingers, the rack and pinion gear’s effect is to move 
the fingers at the same velocity in opposite directions. The model, which is developed 
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Figure 6: System Diagram 

for the force and velocity of one of the fingers, is effected only by the efficiency of this 
gear. 

The finger assembly is modeled as a rigid body since operating forces are far below the 
magnitude necessary to result in significant deflections of the aluminum body. Because 
the motion is strictly linear the moving parts in the finger assembly are treated as a point 
mass located at the nut. Table 2.4 lists the moving parts and their weights. 

Since the errors due to backlash caused by the gears (the motor’s internal gears, 
the acme screw, and the rack and pinion) will be within desired positioning accuracy 
of ±0.25cm, they can be ignored in the model development. Position control will be 
employed only to achieve an approximate desired finger opening; force control will be used 
upon encountering an object. Therefore, a course positioning scheme will be sufficient. 


part 

weight 

long finger 
short finger 
bearings 

0.568 kgs 
0.477 kgs 
0.091 kgs 


Table 2.4 Weight of Moving Gripper Parts 


The last step in the model development is to relate output force at the fingers and 
output velocity of the fingers to the input armature voltage. 

Assume initially that the screw is ideal. For an ideal screw, the translation from 
angular velocity of the motor output shaft to linear velocity of the fingers is 


van = 

and the transformation from torque to force is 

Fc(t) = yT c (0 


(2.16) 


(2.17) 
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where T c (-)and F c (-) denote the coupling torque and force respectively between the screw 
and the nut. Then developing the equations as before 

= T m (t) — T c (t ) — B m u 0 (t) (2.18) 

F L (t) = F c (t) - mV L (t ) (2.19) 

Combining these equations and applying the screw equations (2.16) and (2.17) yields 

F L {t) = (y)?« - ((f) 2 /, + m)V L (t) - (f ) 2 5 m F L (<) (2.20) 

As before efficiency terms, /x and p, are incorporated into the model to account for 
the losses in the non-ideal screw and rack and pinion gears respectively. For an acme 
screw the efficiency is approximately 0.4, and for the rack and pinion 0.7. 

F L (t) = Mj)f n - ((f fJ m + m)V L (t) - (f ) 2 B m V L (t) (2.21) 

Included in the load force, Fl(-), is the friction due to bearing preload which is 
1.362 N. This is arrived at by estimating the preload force at 4.45 N (« 10 lbs), and the 
coefficient of friction for the roller bearings at 0.3. 

Taking the Laplace transform of equations (2.13)-(2.16) and (2.21), after some alge- 
braic manipulation yields 

= W>(&)fr«q(*) 

(/, + (£) 2 m)L a5 2 + ((J m + (&ym)R a + L a B m )s + ( R a B m + whh) 

(^) 2 (L a s-Me a )^(s)_ _ 

(Jm T(5^)I^ + ((/ m + (^) 2 ^)^a + To 5 m )« + (i^a^m + ]*pkikb) 

rp / \ _ fci((/w (^) 2m ) J + ^m)go(^) , 

m ; ’ ~ (Jm + (£) 2 m)I a s 2 + ((/ m + (&ym)R a + L a B m )s + ( R a B m + pphh) 

7 _ , ^ 4 . 23 ) 

(Jm + (^) 2 m)X a s 2 + ((J m + (^r) 2 m)^o + X a B m )s + (#„£„» + 

Found in appendix A are the magnitude Bode plots of the model transfer function for 
position, velocity and force. Obtained from NASA by measuring the gripper response to 
a series of incremented sine waves, the true bode plot for position are found in appendix 
B. The accuracy of the true Bode plot for frequency greater than 8 rad/s is extremely 
poor due to backlash in the system. This will not effect performance since the fingers 
will not be expected to make rapid changes in direction. The actual bode plot reveals 
that for the range of operation the system only second order dynamics are evident. This 
implies that the third order dynamics cause by the nonzero inductance can be ignored 
and thus it can be assumed that the inductance is zero. The magnitude Bode plots of 
the transfer function for position, and velocity with inductance equal to zero have been 
superimposed on the third order model plots found in appendix A. 
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3 State Space Realization 


From the transfer function for the velocity of the fingers comes the position transfer 
function (assuming L a = 0): 


P(s) = 


M&)freq(«) 


+ (£) 2 m)R a s + ( R a B m + upkih)) 


(£ ) 2 RaF L (s ) 


$((J m + (^) 2 m)R a s + ( R a B m + ppk(k b )) 

Rewritten to simplify notation as 

p,-S _ £lfo(£) - CjFl{s) 

' ’ ^(s 2 + C 3 s + c 4 ) 


(3.1) 


(3.2) 


This transfer function describes a linear time invariant system which has two inputs, 
armature voltage, e 0 (>), and load torque, Fl(-), one output, finger position, P(-). The 
minimal realization has two states, finger position, P(-), and finger velocity, Vl(‘). In 
state space form, the minimal system is written as 


{ 


where 


x(f) = A x(f) + Bu(t) 
y(t) = C x(t) 

(3.3) 

A -C -J 

(3.4) 

!) 

(3.5) 

\Cl -Cj/ 

C = ( 1 0). 

(3.6) 


Note that since this realization is minimal, it is both controllable and observable. 

4 Optimal Position Controller (Bang Bang Control) 


It is desirable to determine the control which moves the fingers from the initial state 
(position, velocity), Xo = ( *o 0 /, to the desired final state, x/ = ( xj 0 /, in minimum 
time. Such problems have been extensively studied in optimization theory. One solution 
to the minimum time problem follows from the well known Pontryagin Minimum Principle 
(PMP). The necessary conditions derived from the PMP for linear time invariant systems 
are detailed below [3]. 

4.1 Problem Statement 

Given a completely controllable dynamical system 

x(f) = Ax(<) + Bu(f) (4.1) 
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such that the components ui(t),U 2 (t), . . ,u r (t) of u(<) are constrained in magnitude by 
the relation 

\uj(t)\<Mj j = 1,2,... (4.2) 

and that at the initial time to = 0, the initial state of the system is xo = x(to) , find a 
control u*(-) that transfers the system from Xo to x/ in minimum time. This control is 
called the time optimal control. 

4.2 Necessary Conditions 

Assume that a time optimal control, u*(t), exists that transfers the initial state x 0 to 
x/. Let x*(f) denote the trajectory of the system corresponding to u*(f), originating at 
xo at to = 0, and hitting x/ in the minimum time, T*. Then there exists a corresponding 
costate vector p*(t) such that: 

1. x*(t) and p*(t) are solutions of the canonical equations 

B ff 

i”(<) = “•(<). P*M) = Ax'(l) + Bu'(i) (4.3) 

ft ff 

P •(«) = -^(x*(t),u*(t),p*(t)) = — A'p*(0 (4.4) 

with boundary conditions 

x*(0) = xo, x*(r*) = x/. (4.5) 

Called the Hamiltonian function, 

H(x(t), u(t), p(t)) = 1+ < Ax(t) + Bu(t), p(t) > (4.6) 

for linear time invariant systems. 

2. The relation 

#(*•(<). u*(<), P *(<)) < u (0, P*(t)) (4.7) 

holds for all admissible u(t) and for t G [0,T*]. From equation (4.7), this implies 

<B'p*(<)»u’(t)) < (B'p*(t),u(t)) (4.8) 

holds for all admissible u(t) and for t € [0, T*]. Clearly, < B'p*(t), u(t) > is 
minimized by 

u*j(t) sb —Msgn(bjp*(t)), (4.9) 

where bj denotes the j l h column of B. 

3. The relation 

#(x*(t),u*(t),p*(t)) = 0 (4.10) 

holds for all t G [0, T*]. 

Thus it has been shown that if an optimal control exists, it may only take on values 
±Mj Vj. The second input, Fl{ •), is depend on the particular task and thus cannot be 
set optimally. For the first input, c 0 (-), the set of feasible controls is practically limited 
by the maximum armature voltage, 24 V. 
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4.3 Switching Curves 

The necessary conditions do not contain any explicit information regarding either the 
initial costate, p*(0), or the terminal costate, p*(T*). However, from equation (4.6) and 
(4.10) it follows that the costate, p*(f), must be a nonzero vector. That is 

p *(0 o v* e [o,r*]. (4.11) 


The switching times of the control voltage can be found by finding the time at which 

b' lP *(t) = clp 2 (t) = 0. (4.12) 

Solving equation (4.4) for the costate yields: 

Pi(t) = pj(0) = constant (4.13) 

p* 2 (t) = (~3pJ(0) + p^(0))expc3 - -3px(0) (4.14) 

c c 

Since p\{-) is constant, and pj(0 is monotonic in t, the control voltage changes signs at 
most once. Without information on the initial or final costate, the switching time cannot 
be determined from these equations. 


Disregarding the question of determining the initial or final costate, investigate which 
among the feasible controls just obtained steers the given initial state to the final state. 
Assumed here is that the load force will be essentially constant and equal to the internal 
frictional force. This will be the general case when operating in the position control 
mode. Solving equation (4.1) yields 


+ . „„ _ c3t) (4 15) 

»,(<)- -„ p - c31) (4.16) 


By substituting for u(-) in equations (4.15) and (4.16), find which of the feasible controls 
achieves the desired goal. This control is the optimal control. 


Substituting the model parameters from section 1, it can be seen that the switching 
time is within the position error margins of ±.25cm. 


5 Hardware Implementation 


Chosen to implement the controller in real time, the Mac II has been equipped with a 
MacAdios board for D/A and A/D conversions. To boost the power in the control signal, 
an amplifier was built using the Burr-Brown high power operational amplifier (Figure 
9). The decision to use the Mac II was based on the need for a design environment 
that would facilitate rapid design and testing of control algorithms. In addition the 
mouse/icon oriented environment allows new users to come up to speed with a minimum 
of training. 
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Figure 7: Hardware Flow Diagram 


The time optimal position controller has been implimented. The controller can posi- 
tion to within ±.25 cm of the desired position without overshoot. The top velocity can 
be set arbitrarily between the maximum value, approximately 1.25 cm/s, and 0 cm/s. 

Since fingers equipped with the full array of strain gauges have not yet been delivered 
by NASA, the force controller currently running receives force information from only one 
strain gauge on each finger and thus is not able to compute the grip points or finger 
torques. Any finger force between 0 N and approximately 6.0 N can be maintained. 
Addressing the problem of hitting an unexpected obstacle, the hybrid force/position 
controller stops if a prespecified force is achieved during positioning. 

5.1 Future Plans 

Impeded by disagreements in the initial design environment and delays in delivering 
the mechanical hardware, progress is slow and there is still much work to be done. The 
major focuses are detailed below. 

% 

1. Upon receipt of the fingers equipped with the complete array of strain gauges, an 
algorithm which determines grip points an finger torques will be tested. 

2. Once the control algorithms have been perfected, they will be programmed onto a 
dedicated signal processing chip and the Mac II will be used only for higher level 
processing, leaving the low level calculations and commands to the signal processing 
chip. 
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Figure 8: Amplifier Diagram 
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